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Find Target torque 
(Req_trq) 
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Motor rotational 
nunber Nm(n) 
detecting 
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Band pass filter calculation 
BNm(n) = a1*BNn(n-1)+a2*BNn(n-2)+bl *Nm(n)+b2*Nm(n-1)+b3*Nm(n-2) 



PD control calculation 
PD_out = Kp*BNn(n)+Kd* (BNm(n)-BNn(n-l)) 

I 



Instruction torque calculation 
Tn = Req_tro - PD_out 
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Instruction torque Tn 
Current ins truction value I, Angle instrucation value 0 

/ Current instruction value, 7 
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Motor stop process 
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Design method 



Identification experiment 



Model parameter identification 
by frequency fitting 



Reference model derivation 



PD control calculation by 
model matching method 



performance estimation 
condi t ion: 
satisfied i 

Yes 



Scattered of controller 
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Design nethod 



Identification experiment 
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Model parameter identification 
by frequency fitting 



Reference model derivation 



Characteristic fluctuation 
derivation 



Noise characteristic 
deri vat ion 



Weighting function set 



Generalized plant creation 



Control ler K(s), 
Scaling matrix D calcuration 




Reduced model for controller 



Scattered of control ler 
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Fig. 14 
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„ Corrected amount calculation 
U(k) = l a I u ( k — I ) + £ b I Nm (k — I ) 

1=1 1=0 



Instruction torque T for motor calculation 
T - Req_trq + u(k) 
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Instruction torque Tn (by nap serch) 
►Current instruction value I , Angle instruction value 6 
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Current instruction value, 
Angle instruction value output 
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